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I.  INTRODUCTION 


The  Disturbance  Accommodating  Controller  (DAC)  design  method  was 
developed  by  Dr.  C.  D.  Johnson  (References  1-5)  of  the  University  of 
Alabama  in  Huntsville.  This  method  uses  a  combination  of  waveform-mode 
disturbance  modeling  and  state-variable  control  techniques  and  permits 
three  primary  modes  of  disturbance  accommodation:  (1)  cancellation 
(absorption)  of  disturbance  effects,  (2)  minimization  of  disturbance 
effects  and,  (3)  utilization  of  disturbance  effects  as  an  aid  in 
accomplishing  the  primary  control  task.  This  report,  and  the  digital 
simulation  presented  herein,  will  deal  with  the  methods  associated  with 
the  first  mode,  i.e.,  absorption. 


The  plant  considered  is  one  which  can  be  described  by  state  equations 
of  the  Form 


where 


x  =  A  x  +  B  u  +  F  w 

Z  =  Cx  +  I2u  +  Gw 


(1) 


x  is  the  plant  state  vector 

u  is  the  plant  control  input  vector 

w  is  the  vector  of  external  disturbances  acting 
on  the  plant 

£  is  the  system  output  vector,  and 

A,  £»  £*  £*  £»  £  are  appropriate  size,  known 
matrices  which  are  not  necessarily  constant. 


The  disturbances  considered  are  assumed  to  be  described  by  the  following 
general  set  of  linear  disturbance  state  equations: 


w  -  H  z  +  L  x. 

(2) 

z  =  Dz  +  Mx  +  o 


where 


z_  is  the  disturbance  "state"  vector 

a  is  a  sequence  of  randomly  arriving  vector  impulses,  and 
D,  H,  L,  M,  are  known,  tine— invar lent  matrices. 

Since  neither  a  complete  set  of  plant  state  variables  nor  the  various 
components  of  the  disturbance  are  available  for  direct  on-line  measurement 
in  most  practical  applications,  the  DAC  is  restricted  to  operate  only  on 
Information  in  the  available  on-line  measurements  of  the  system  outputs  and 
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H 
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commands  and  on  any  disturbance  components  which  may  actually  be  available 
for  direct  measurement.  Since  the  plant  and  disturbance  states  (x,  z)  are 
required  for  a  practical  DAC  implementation,  the  necessary  data,  if  not 
available,  must  be  generated  via  use  of  state  reconstructors  (observers) 
operating  on  real-time  system  outputs  £  and  control  Inputs  u. 

A  full-dimensional  observer  which  can  be  used  to  generate  the  plant 
and  disturbance  state  estimates  (x,  z)  for  the  equations  of  the  form  (1) 
and  (2)  is  given  in  Reference  2  as 


where 

—1*  —2  are  8aln  matrices  to  be  designed,  and 
A,  £,  L,  C,  G,  H,  D,  M  are  as  previously  defined. 

For  acceptable  observer  performance,  the  real-time  estimation  errors 

E  »  X  -  X 

— x  —  — 

(4) 


must  settle  to  zero  rapidly  in  comparison  to  system  settling  times  where 
e  and  e  dynamics  are  governed  by 


II.  PLANT  MODEL 

This  simulation  will  model  a  fourth-order  plant  expressed  in  the  form 
shown  in  Figure  1. 


The  transfer  function  across  the  plant  is 

y  (s)  K  [s4  +  b1s3  +  b2s2  +  b3s  +  b^ 

_  _  _  _ 
u^(s)  s  +  b^s  +  bgS  +  byS+  bg 

and  this  can  be  diagrammed  as  shown  in  Figure  2.  As  can  be  seen  from 
Figure  2, 


s 

x2  +  ^*iui  " 

b5y 

x2 

a* 

x3  +  K^2u1  - 

V 

*3 

= 

X4  +  ^“l  ~ 

V 

*4 

= 

Kb4ui  -  bgy 

y 

+  Ku^ 

For  purposes  of  DAC  design,  equations  (6)  need  to  be  expressed  as 
functions  of  x,  u,  and  w.  Therefore,  since 

u^  =  u  +  w,  then 

y  =  +  K(u  +  w) 

=  -  b^x1  +  x2  +  K(u  +  w)  (b^  -  b5) 

i2  *  ~  b6xi  +  x3  +  K<u  +  »)  (b2  -  bg)  (7) 

Xj  "  -  b7Xj  +  x^  +  K(u  +  w)  (b3  -  b7) 

«  -  b^  +  K(u  +  w)  (b^  -  bg) 


In  matrix  form.  Equations  (7)  can  be  written  as 


These  correspond  to  Equations  (1). 
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III.  DISTURBANCE  MODEL 


The  general  set  of  equations  describing  the  disturbances  were  given 
in  Equations  (2).  In  this  report,  it  is  assumed  that  the  disturbance  is 
not  dependent  on  the  plant  state,  i.e.,  L  =  M  =  0.  Therefore,  the 
disturbance  modeled  in  the  subroutine  is 

w  =  H  -E 

(10) 

A  =  D.  z  +  £(t) 

and  it  has  been  restricted  to  be  a  second-order  model  which  can  be  represented 
as 


w  =  H  z  =  (h.  h„)  / z 


Dz  +  a  =Td,  d 


‘  G)  «■> 


IV.  DISTURBANCE  ABSORBER  CONTROL 


For  the  complete  absorption  mode  of  DAC  design,  the  object  is  to  obtain 
a  control  vector  which  will  completely  cancel  out  the  effects  of  the 
disturbance  input.  First  ,  however,  it  must  be  verified  that  such  a  control 
exists  for  the  particular  case  being  considered. 

It  has  been  shown  (Reference  1)  that  such  a  control  vector,  u  ,  will  exist 
if,  and  only  if, 


F  =  B  £ 

for  some  £.  With  the  disturbance  summed  at  the  plant  input,  as  shown  in 

Figure  1,  we  can  see  from  the  representation  in  Equation  (8)  that  F  B  £ 

for  £  =  [1],  Therefore,  for  this  plant-disturbance  model,  u  exists  and 

is  u  =  -  T  w  =  -  w. 

— c  -  — 

Since  the  disturbance  states  z^  and  z2  cannot,  in  general,  be  measured, 
in  order  to  implement  the  control  u  the  state  reconstructor  given  by 
Equation  (3)  must  be  used  to  provide  £j  and  z2.  The  DAC  control  for  this 
configuration  will  then  be  given  by 


^  _  w  =  _  h^j  -  h2z2  •  (13) 


V.  STATE  RECONSTRUCTOR  DESIGN 


In  order  to  implement  the  state  reconstructor,  it  is  first  necessary 


to  design  the  gain  matrices  K  and  K_.  This  is  done  by  using  Equation  (5) 
with 


% 


'll 


21 

‘31 

‘41 


Substituting  the  appropriate  values  into  the  first  term  on  the  right-hand 
side  of  Equation  (5)  and  performing  the  indicated  matrix  multiplications 
and  additions  will  result  in  the  relation 


<kll 

-  b5> 

1 

0 

0 

h1K(b1 

-  b5  + 

kll> 

tijKfbj  -  b5  +  ku> 

(k21 

-  b6> 

0 

1 

0 

h1K(b2 

~  b6  + 

k2i> 

h2K(b2  -  b6  +  k21) 

(k31 

"V 

0 

0 

1 

hlK<b3 

-  b7  + 

k31> 

V<b3  -  b7  +  k31> 

(k41 

-v 

0 

0 

0 

hxK(b4 

~  b8  + 

k41> 

V<b4  -  b8  +  k41) 

k12 

0 

0 

0 

(di  + 

Khlk12) 

(d3  +  Kh2k12) 

k22 

0 

0 

0 

(d2  + 

Kh1k22) 

(d4  +  Kh2k22) 

For  computation  simplification,  let  this  be 


e 


A  c  + 


(16) 


and  represent  A  as 


A 


eo 

l 

0 

0 

e6 

e12 

el 

0 

1 

0 

e7 

e13 

C2 

0 

0 

1 

e8 

e14 

C3 

0 

0 

0 

e9 

e15 

e4 

0 

0 

0 

eio 

e16 

1 - 

n 

x-n 

0 

0 

0 

611 

e17 

(17) 


Now,  A  represents  the  characteristic  matrix  of  the  £  dynamics.  As  stated 
earlier,  it  is  desired  that  £(t)->  o  "rapidly"  for  good  reconstructor  performance. 
This  means  that  the  roots  of  the  characteristic  equation, 


det  [  A  -  XI.]  =  0  , 

should  be  "large"  negative  numbers.  The  next  step,  therefore,  (and  generally 
the  most  tedious), is  to  calculate 

det  [  A  -  XI  ]  . 
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Remember  that  A  has  unknown  gain  components  included  and  is  not  just  an 
array  of  known  numbers.  Therefore,  we  have 


det  [A  -  XI  ]  = 


A  -  XI 


"1 

21"17 
55G13 


+  (e2eHel6 


(e0  - 

X)  1 

0 

0  e6 

e12 

el 

-X 

1 

0  e? 

e13 

e2 

0 

-X 

1  e8 

®14 

e3 

0 

0 

e9 

®15 

e4 

0 

0 

0  eio-x 

e16 

e5 

0 

0 

0  ell 

fi17 

lives 

:  +  e 
0 

10  +  e17 

)  X 

5  +  (eoeio  + 

eoe: 

e4e6 

-  e5e12) 

x4 

+  (e0eliel6 

-  e2 

+  e4e6e 

17 

“  e4elle12  ~ 

V 

)  X3 

+  (elell 

el6 

-  ele10e17 

f  e2' 

17  " 

e4ellel3 

- 

e4e8  "  e5e76 

16  + 

'11  16  10  17 

L7  +  elel0 


i5e6e16  +  e5e10el2 


2  17  3 

B10ei3  "  e5C14)  X 
e2ei0ei7  +  e3®10  +  e3®17  +  e4C8ei7  “  e4eilG14 


“  e4e9  e5e8ei6  +  e5eiOei4  e5&15)  X  +  (  "  e3elOG17 
+  e3eHei6  +  e4e9ei7  "  e4eHei5  -  e5e9e16  +  e5el0e15)  =  0 


(18) 


If  the  desired  roots  of  Equation  (18)  are  X^,  X2>  X^>  X^,  X^,  X^,  then 
the  desired  characteristic  equation  is 


(X  -  xx)  (X  -  x2)  (X  -  x3)  (X  -  x4)  (X  -  x5)  (X  -  x6)  =  0  • 

Expanding  Equation  (19)  and  equating  coefficients  of  like  powers  of  X  between 
Equations  (18)  and  (19)  and  substituting  the  proper  symbols  which  the  e^ 
represent  results  in  the  following: 


(19) 


^  kll  +  Khlk12  +  Kh2k22  +  ^dl  b5  +  d4^  =  X1  +  X2  +  X3  +  X4 


+  X-  +  X,  =  A, 

JO  1 
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(b)  (d1  +  d4)  kxl  +  (-  Kd2h2  +  Kd4hx  -  Kh^)  k12  +  (-Kd3h1  +  Kdxh2 

-  KblV  k22  -  k21  +  b5dl  “  b5d4  '  d2d3  “  Va  +  V 


5 

I 

J  -  1 


6 

c 


.1  =  i  +  1 


Vj 


(c)  (d3d2  -  dxd4)  kix  +  (Kh1b1d4  -  Kh2b1d2  -  Kh^)  k12  +  (-  Kh1b1d3 


+Kh2b1d1  -  Kh2b2)  k22  +  (d3  +  d4>  k21  -  k31  +  (-  bjd.^ 


+  Vid4  *  b6dl  "  b6d4  +  V  =  " 


^  4 

l 

i  =  1 


5 

z 


i  +  1 


6 

L 

i  -  j  +  i 


LAlAjAl  *  -a3 


(d)  (Xb2h1d4  -  Kb2h2d2  -  Kb^)  k12  +  (  -  Kb2h3d3  +  Kb2h2di  -  Kb3h2)  k22 
+  (d3d2  '  W  k21  +  W  +  d4)  k  -  ktl  +  <-  bid  +  Wl 


-  h7dl 


b7d4  +  V  = 


r  3  A  5  6 

L  L  L  L 

i-l  j  =  i  +  1  1  =  j  +  1  n  *  1  +  1 

LXiXjXlXn  "  A4  *’ 

(e)  (d3d2  -  dxd4)  k31  +  (-  d3d2b?  +  d3d4b?  -  dxb8  -  d4bg)  +  (-  Kh3b3d3 

+  Kh2b3dl  +  Kh2b4)  k22  +  (Khlb3d4  “  Kh2b3d2  “  “W  kl2  +  (dl  +  V  k41 
-  -  [a1a2A3A4  <a5  +  V  +  X1X2X5X6  (X3  +  V  +  X3X4X5X6  (X1  +  X2}  J 

=  'A5 

(f)  (  -  +  d3d2)  k41  +  (b8dil4  -  b8d2d3)  +  (Khlb4d4  -  Kh2b4d2)  k^ 

+  (-  Kd3b4h1  +  Kd1h2b4)  k22  =  A1A2A3A4A5A6  “  \  • 

For  ease  of  manipulation,  let  us  re-express  (a)  -  (f)  as 


(a)  k 
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+  n>Qk^2  +  m1^22  +  m2 


(b)  m3k11 


21 


(c)  m7ku  +  m8k21  -  k31 


(d) 

(e) 

(f) 


m12k21  +  m13k31  ~  k41 

m17k31  +  m18k41 
m22k41 


+  m4k12  +  m5k22  +  m6  - 

+  m9ki2  +  m10k22  +  ”ll 
+  ml4k12  +  m15k22  +  m16 

+  ml9k12  +  m20k22  +  n*21 
+  m23k12  +  m24k22  +  m25 


-  A- 
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or,  in  matrix  form. 


~1 

0 

0 

0 

mo 

ml 

1 

7? 

H* 

H* 

_ 1 

i— < 
< 

i _ 

'  “2 

m3 

-1 

0 

0 

m4 

m5 

k21 

A2 

"  m6 

m7 

m8 

-1 

0 

m9 

mio 

k31 

“A3 

"  mll 

0 

”12 

“13 

-1 

m14 

m15 

k41 

— 

A4 

"  ”16 

0 

0 

”17 

ml8 

"19 

m20 

k12 

-A5 

-  m21 

_0 

0 

0 

m22 

m23 

0 

£ 

CS| 

CM 

_ 1 

-A 

'  ”25- 

(20) 


Therefore,  we  have  X 


[H-  * 


where 


k11 

% 

Lk«J 


•h  ■  fe] 


(21) 


rsii  r^ii  -i  -i 

Solving  forLK2J  gives  L^J  ”  X  R  where  X  denotes  the  inverse  of 
the  matrix  X  .  Since  X  is  composed  of  known  numbers  when  the  desired  values 
of  A1  to  A  are  substituted  in,  this  matrix  can  be  inverted  via  use  of  a 
matrix  inversion  subroutine. 

Therefore,  the  components  of  the  gain  matrices  and  are  determined 
as  functions  of  the  plant  and  disturbance  parameters  and  the  values  of  A^ 
through  A^  chosen  by  the  designer.  It  will  usually  be  necessary  to  go 
through  several  iterations  on  values  for  the  A's  before  the  desired  observer 
performance  is  obtained. 

Having  these  gains,  it  is  now  possible  to  construct  the  state  observer. 
Equation  (3),  as 


M 

^11 

-V 

1 

0 

0 

hlK(bl 

-  b5  +  kn) 

h2K(bj_ 

-  b5  +  kn 

*2  ' 

(k21 

-  V 

0 

1 
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h1K(b2 

"  b6  +  k21> 

h2K(b2 

"  b6  +  k21 

*3 

(k31 

"  b7) 

0 

0 

1 

h1K(b3 

-  b7  +  k3l> 

h2K(b3 

"  b7  +  k31 

X4 

(k41 

-v 

0 

0 

0 

hlK(b4 

-  b8  +  k41> 

h2K(b4 

"  b8  +  k41 

S  1 

k12 

0 

0 

0 

(dl  + 

Kh1k12) 

(d3  + 

Kh2k12) 

*2  / 

-k22 

0 
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0 

<d2  + 

Khjk^) 

(d4  + 

Kh2k22) 
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12 
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! 
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'kll~ 

KO^  -  b5  +  kn) 

k21 

K(b2  -  b6  +  k21) 

k31 

K(b3  ~  b?  +  k31) 

k41 

lit)  + 

K(b4  "  b8  +  k41> 

k.  „ 

Kk,  „ 

12 

12 

_k22_ 

_Kk22  J 

and  thus  obtain  the  disturbance  state  estimates,  z^  and  z^,  required  for 

the  DAC  control  u  . 

- c 

Figure  3  presents  the  overall  block  diagram  for  the  composite  plant- 
state  reconstructor  model.  The  symbols  r^,  p^,  relate  to  matrix  elements 
from  Equation  21  as  shown  in  Table  1. 

VI.  DIGITAL  SIMULATION 


This  simulation  has  been  assembled,  for  use  on  a  CDC  6600  digital  computer, 
in  order  to  permit  the  design  of  DAC's  for  systems  of  the  type  shown  in 
Figure  1  without  the  necessity  of  having  to  go  through  the  tedious  task  of 
expanding  determinants  by  hand.  This  simulation  can  be  used  in  a  design 
orocess  to  determine  the  necessary  gains  for  a  given  svstem  and  then  simulate 
that  system's  operation  for  various  disturbance  conditions.  Or,  the  simulation 
could  be  modified  and  used  as  a  subroutine  in  a  larger  program  to  provide  a 
necessary  disturbance  control  value  when  called. 

As  a  design  tool  used  by  itself,  the  simulation  will  perform  the  following 
tasks:  (1)  calculate  the  elements  of  the  gain  matrices  and  K  utilizing 

the  plant  and  disturbance  input  parameters  and  the  X's  input  by  the  designer 
(2)  implement  the  state  reconstructor ;  (3)  calculate  the  DAC  control  vector  ; 


=  -  h^  -  h2z2, 


and  (4)  close  the  DAC  control  loop  through  the  plant  to  provide  output  data 
showing  the  overall  performance  obtained. 


As  a  subroutine,  the  necessary  plant  output  and  other  data  can  be  transferred 
in  through  a  COMMON  block;  the  gains  can  be  updated,  if  required  by  changing 
plant  parameters;  the  value  for  u*.  can  be  determined;  and  then  required  data 
can  be  transferred  out  through  a  COMMON  block. 


An  overall  program  dictionary  is  presented  in  Table  2.  Table  3  lists 
the  NAMELIST  inputs  for  the  program,  and  Table  4  lists  the  outputs.  A 
System  Library  Line  Printer  Plot  Routine  is  used  to  plot  the  output,  Y,  and 
the  disturbance  state  estimates  zj.,  Z£ • 
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Composite  plant  -  DAC  block  diagram. 


I 


TABLE  2.  PROGRAM  DICTIONARY 


FORTRAN  NAME 

SYMBOL 

DEFINITION 

A 

Ai 

Coefficients  of  the  desired  character¬ 
istic  equation  associated  with 
[A  -  XI]  calculated  using  input 
eigenvalues. 

AMO-AM25 

”i 

Coefficients  of  the  characteristic 
equation  associated  with[X  -  X_l] 
calculated  using  actual  plant  and 
disturbance  input  parameters, 
factored  according  to  components  of 
the  and  JO,  matrices. 

B 

bJ 

Coefficients  in  the  plant  transfer 
function. 

CO,  Cl 

Co‘ 

C1 

Coefficients  used  in  defining  w(t). 

C 

K 

Plant  transfer  function  gain  value. 

CU1 

Defined  as  K'U^. 

CK 

JSl. 

—2 

Array  containing  computed  values  for 
the  gain  matrices.  CK(1)  -  CK(4) 
correspond  to  Kj,  CK(5)  and  CK(6) 
correspond  to  K^. 

D 

di 

Array  consisting  of  the  elements  of  the 

D  matrix  associated  with  the  disturbance 
state  model. 

DT 

At 

Integration  step  size. 

H 

hi 

Array  consisting  of  elements  of  the  H 
matrix  associated  with  the  disturbance 
state  model. 

KUTTA 

Integration  loop  counter. 

KU 

Integration  loop  counter. 

LM 

Xi 

Eigenvalues  of  |A  -  X_I  |  -  0  chosen  by 

designer  to  settle  out  state  reconstructor 
response. 

NX 

Number  of  derivatives  to  be  integrated. 

PGO 

ur 

Plant  Input  Command  1 

- - - — -- .  —  . . -i 

TABLE  2 .  (CONCLUDED) 


FORTRAN  NAME 

SYMBOL 

DEFINITION 

R 

R 

Matrix  used  in  solving  for  and  K^. 

STPS7. 

Used  to  define  integration  step  size 

At  -  l./STPSZ. 

T 

Intermediate  terms,  comprised  of  various 
combinations  of  the  X's,  defined  for  use  in 
later  equations. 

TIME 

t 

Total  elapsed  time  (sec). 

TSTOP 

t  _ 
stop 

Run  end  time  (sec). 

U1 

U1 

Summation  of  u  with  disturbance  magnitude,  \ 

u 

u 

Summation  of  plant  input  command,  vi  ,  DAC 
control  term,  u  ,  and  plant  output  feedback 
y. 

UDA 

u 

DAC  control  vector. 

W 

w(t) 

Disturbance  vector. 

XI  -  X4 

X1  "  X4 

Plant  states. 

XD1  -  XD4 

X1  '  x4 

Plant  state  derivatives. 

XDH1  -  XDH4 

•  • 

X1  "  x4 

State  reconstructor  state  derivatives 
corresponding  to  -  x^. 

XH1  -  XH4 

X1  "  X4 

State  reconstructor  states  corresponding  to 
xi  “  x4* 

XM 

Array  of  elements  of  X  matrix. 

—in 

Y 

y 

Plant  output. 

Z 

Intermediate  terms,  composed  of  various 
combinations  of  the  X's,  defined  for  use  in 
simplifying  later  equations. 

ZDH1,  ZDH2 

h’  *2 

State  reconstructor  disturbance  state 
derivatives. 

ZH1,  ZH2 

*!•  *2 

State  reconstructor  disturbance  state 
estimates. 

TABLE  3.  NAMELIST  INPUT  VARIABLES 


FORTRAN  NAME 

SYMBOL 

DEFINITION 

B 

bi 

Array  consisting  of  the  coefficients,  -  bg, 

of  the  plant  transfer  function  y/u^. 

C 

K 

Plant  transfer  function  gain  value. 

CO,  Cl 

V  C1 

Coefficients  used  in  defining  w(t). 

D 

di 

Array  consisting  of  the  elements  of  the  D 
matrix  associated  with  the  disturbance  state 
model.  The  elements  are  entered  according 
to  the  subscripts  shown  in  Equation  (12). 

H 

hl 

Array  consisting  of  elements  of  the  H  matrix 
associated  with  the  disturbance  model.  The 
elements  are  entered  according  to  the 
subscripts  shown  in  Equation  (11). 

LM 

Xi 

Array  consisting  of  designer's  choice  of  roots 
for  the  characteristic  equation  of 
|A  -  XI | .  The  array  permits  input  of  complex 
conjugate  values  for  the  roots  in  the  form 
a  +  jb.  For  this  reason,  the  input  format 
which  must  be  used  is: 

(RE1,IM1),  (RE2,  IM2),  (RE3,  IM3),  (RE4,  IM4)  , 

(re5,  im5),  (re6,  im6). 

NPRT 

- 

Used  to  control  output  print  interval. 

NUMBR 

- 

Used  to  control  data  storage  for  plots. 

NX 

- 

Number  of  derivatives  to  be  integrated  by  the 
Runge-Kutta  integration  subroutine. 

PGO 

u 

r 

Plant  input  command. 

STPSZ 

- 

Used  to  define  integration  step  size  as, 

DT  =  1. /STPSZ  (sec). 

TSTOP 

tSTOP 

Run  end  time  (sec). 
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TABLE  4.  DIGITAL  SIMULATION  OUTPUT  VARIABLES 


FORTRAN  NAME 

SYMBOL 

DEFINITION 

PGO 

u 

— r 

Plant  Input  command 

TIME 

t 

Total  elapsed  time  since  beginning  of 
run  (sec) 

UDA 

u 

-n c 

DAC  control  vector 

W 

w 

Disturbance  magnitude  as  determined  from 
differential  equation  used  to  describe  it. 

XI  -  X4 

X1  -  x4 

Plant  states 

XD1  -  XD4 

Xl-X4 

Plant  state  derivatives 

XDH1  -  XDH4 

•  • 

A  A 

X1  “  x4 

State  reconstructor  state  derivatives 
corresponding  to  XD1  -  XD4. 

XH1  -  XH4 

A  A 

X1  ~  X4 

State  reconstructor  state  estimates 
corresponding  to  XI  -  X4. 

Y 

y 

Plant  output. 

ZDH1,  ZDH2 

V  *2 

State  reconstructor  disturbance  state 
derivatives. 

ZH1,  ZH2 

V  s2 

State  reconstructor  disturbance  state 
estimates. 
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WRITE (fc, 500)  R 

C - 0  0  L  U  V  *  \  C  .  1  -  E  L  E  v  E  *  T  c  1  T  *-  P  U  6 

'  K ( 1 ,1  )  =  1  .  C 

y  y  <  2 ,  l  >  =  a  a*  2 

y  y  ( 2 ,  l )  =  a w  7 

>  y  (  A  ,  1  )  =  X  y  (  5 , 1  )  =  >  M  (  f.  ♦  1  )  =  C  .  0 

c - C0LUM2  AC.  2  -  E  L  E  “  E  M c  7  Th&u  12 

v  v ( 1  ,  2  )  =  0.0 

>IM2.2)  r  -  1  «  C 
y y ( 3 . 2 )  =  £  v  « 
w<a,2)  =  A"12 

>  V  <  5  *  2  I  =  X  M  (  6  »  2  )  =  0.0 

C - 0  C 1 1  y  a  AO.  2  rlEvFM<?  12  T  H  a  l.  it 

X  v  ( 1  .  3  )  =  X  v  (  2 , 2  )  =  O.f' 

*y<2,2)  =  -1.0 

X  y  ( 4 , 3  )  =  A  "  1  2 
X  y  <  5 , 3  )  =  A  v  1  7 

yv<6,2)  =  o.c 

C - - CCU^A  AO.  4  -  EL E* CATS  lc  T  5  R  L  24 

v  y  ( l  *  a  >  -  x y ( ? , 4 )  =  y y ( 2 » 4 )  =  0,0 

xv(A,A)  =  -1.0 
y  y  <  5 »  a  )  =  avis 

xR (0,4)  =  \»22 

C - COLIMA  AC.  5  -  ELE^EATE  25  T  R  D  L  20 

yy  ( i ,?  )  -  a vo 
>y(2»5)  =  A  v  A 
x  y ( 3 ♦ 5  )  -  A  v  9 
X  v ( 4 , 5  )  =  avia 

xV(5,5)  r  A  v i g 

VV(&,5)  =  A  V  2  3 

c - rCLUyA  AC.  6  -  E  L  E  v  F  ATS  21  THRU  ?f 

y.y<l.f)  =  Ayi 
x  v  <  2 , 6 )  =  Av5 
yy <2,f )  =  Ayio 
»y <a,6)  =  a  y i 5 
yy (5,f )  =  Ay2C 
yy(f,,f)  =  a  v  2  a 
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K  c  '  » A  V  ■  ..  1  l\ 


I  “  I  I  t 


C  ►'  I  _  _ 


r  1  A  ft  •  l.  *4 


CC  2G  I  :  1*  6 

2  0  WRITE<6.200>  T  .  XMd  »  1  >  •  I*  X Y  d  ♦?  >  «  T.  XV(I.»), 

.  i .  x  y  d » 4 ) ,  i ,  x  y  d « * )  t  l .  x  y  d ,  *  > 

17*=  C - CALCULATE 'INVFRSr-Cr  raTcxv  ,  yr  v-  . 

TALL  SFSOMI  (  X«,  6,  6,  1*  6,  CET.  RA,  E «  WORK,  IHLCt 
IP  (  CET  .FC.  C.O  ,CP.  r  .EC.  l.C  )  CC  TC  2  2  0  0 
IF  (  E  .EG.  2.0  )  W c  17  E  <  F  *  5  2  0  0  ) 

■'040  1  =  1,6 

IPO  40  WRITE (6,200)  I,  X  Y (I , 1  )  ,  I,  X  Y  d  .  2  >  ♦  I  ,  X  Y (I  , J )  , 

.  i,  xm(I,4),  i,  xYd*5>*  i,  yvd,g>  ""  . 

u  R  I  T  r  (  6  .  P  C  0  )  CET.  RA,  E 
PC  5C  I  =  1.  6 
:c  5*  V  =  1,  6 

1 F  5  5  0  VYId**J)r  X  Y  (  I,  «J  ) 

CALL  YYPY  <  XYI,  0,  CK.  fc.  6 «  1  ) 

*  R  I  T  r  (6.500)  CK  .  . . -  .  ' 


'Cl 

-  X  C  2  =  XCT  = 

y  r  ft  = 

0 . 0 

'  1 

=  X?  =  X  3  =  X4 

=  0.0 

ICO 

'  CF1 

=  XCP?  =  X  C  F  7 

r  X  C  Ft* 

=  ZCF1  =  ZDF2  = 

c 

.0 

X>1 

=  X  F  2  =  y  H  3  - 

XF4  = 

Z F 1  -  ZF2  =  C.0‘" 

C  T 

=  1.0  /  ?TFRZ 

1  # 

—  0 

'  *  ~  ■*“  ...  . 

T  I  (K  E 

=  0.0 

1 F  r 

IF 

r  IVFRT  -  1 

JFTR 

=  STFSZ  /  MYRR 

T  PLT 

=  TPTR  -  1 

- 

■PTC 

=  C 

v  v  A  X 

=  -1  0  00  0  00  .'' 

"  ••  "  '  ' 

2CC 

vYIA 

=  1000000.0 

Y  Y  A  X  1 

-  y  v  fi  x  2  =  -ICC 

0  C  0  0  .  C 

VYIM 

-  YYIR2  =  iroooco.o 

11C  .CMIMF 

Ip  ( 

T  I 

YE  .FE.  TSTd  ) 

rr  to. 

1CCC 

?cc 

'  c  2  r 

CO 

=  J  +  1 

K  L  =  1  ,  4 

•  L  TT  A 

-  K  L 

=  CO  ♦  Cl  *  E  X  P {  ALP 

*  TIYE  ) 

LEA 

=  F  (  1  1  *  7F1  *  F 

(  2  )  *  ?  F  ? 

21  ” 

l 

'  1 

=  PCC  -  Li C A  - 

=  u  ♦  w 

Y 

- 

C  L  1 

-  C  *  11 

.•  C  4 

-  CL1  *  F  (  4 

)  -  F 

(  F  >  *  Y 

>  r  3 

=  X4  ♦  CL1  ♦  P 

<  3  ) 

-  F  C  7  )  *  Y 

215 

v  r? 

=  X3  ♦  GUI  *  E 

(  2  ) 

-  F  (  6  >  *  Y 

• 

'Cl 

=  X2  ♦  CU1  *  E 

{  1  ) 

-  F  (  c  )  *  Y 

V 

=  XI  ♦  CL’] 

>  CM 

=<CK(1>- 

-  (  c 

)  )  *  x>-i  ♦  xi  ? 

♦ 

n 

•  L. 

* 

<  c  (  1  )  -  p  ( 

c  )  ♦ 

CK  <  1  )  )  . 

22' 

.  ( 

h 

<  1  )  *  ZM1  ♦  F 

<  ?  ) 

*7P2*L>-C* 

(  i 

>  * 

YCP2 

r(CK(?'- 

?  <  * 

)  )  *  X>-i  +  y  F  3 

4* 

.  C 

* 

<  E  (  2  )  -  r  ( 

f  )  ♦ 

CK  (  2  )  )  * 

.  ( 

u 

(  1  )  *  Z  F 1  ♦  F 

(  2  ) 

*  Z f  2  ♦  l  )  -  CK 

f  2 

)  * 

V  c  (.  2 

-<CK<3>- 

r  (  7 

)  )  *  XM]  ♦  VF4 

♦ 

2  2 ' 

.  C 

* 

f  F  (  3  )  -  c  ( 

7  >  ♦ 

CK  {  3  5  )  * 

.  ( 

K 

(  1  )  *  ?  F  1  .  F 

<  ?  ) 

*  Z  u  2  ♦  l  )  -  CK 

(  7 

)  * 

v  C  F  4 

=  f  CK  <  4  )  - 

E  <  n 

)  )  *  V1  1  ♦ 

.  C 

* 

<  F  (  4  )  -  c  ( 

F  >  ♦ 

CK  (  4  )  >  * 

1.  1.  1  ) 


Y 


Y  -  ' 


Y 
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2  3  0 


235 


24  0 


245 


2  5  C 


255 


250 


2  6  ^ 


27C 


275 


2<=0 


2  8  5 
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• 

<  F 

< 

1  ) 

*  7  F  1  4 

F  ( 

2 

)  * 

Z*-2 

4  ( 

)  - 

CK  (  4 

)  *  v 

"CM 

=  Ck 

(  5 

)  * 

X  F  1 

4 

(  C 

( 

1 

)  4 

r  * 

F  (  1  > 

*  C  K  (  4  ) 

) 

• 

?Fl 

♦ 

<  C 

<  2 

)  4 

C  * 

F 

<  2 

) 

* 

CK  ( 

p 

)  >  * 

• 

ZH2 

- 

C  K  < 

5  ) 

* 

Y  “4 

C 

*  CK 

( 

c; 

)“  * 

l 

' 

7CF2 

=  Ck 

<  6 

)  * 

X  F  1 

4 

t  C 

( 

)  4 

c  * 

F  (  1  ) 

*  CK  (  C  ) 

) 

• 

7F1 

4 

<  D 

(  4 

)  4 

c  * 

F 

(  2 

) 

* 

CK  ( 

c 

)  )  * 

• 

7  F  2 

- 

Ck  < 

5  > 

* 

Y  4 

r 

*  Ck 

( 

e 

>  * 

u 

'C  TO 

( 

5  0  0  0  * 

£00  0  , 

30  00 

♦ 

40  00 

) 

t 

K  U  T  T  A 

5  0  00  CONTINUE 

IFLT  =  TFLT  4  l 

IF  <  I  PL  T  .  N  F  •  IFTR  )  OC  TO  2020 

I  P  L  T  =  0 

f  P T S  =  \P  T  S  4  1 

XT(NPTS>=  TI*F 

YT (APTS>=  Y 

'WAX'  -  A*  AX]  <  Y"' AX*'  Y  ) 

YY1A  r  AKIA  1  <  WIN,  Y  > 

,7  IT  C.  P  T  o )  =  7  F  1 
7  2  T  <  A  F  T  S  )  =  7  F  2 

v  v  A  X  1  =  avaxi  (  yvfxj,  2  h  1  ) 

YVIM  =  AFIM  r  y^IM,  ?  H I  ) 

YVAX"  =  A  v  A  X  1  (  Yf-AX?.  Z  F  2  )' 

Y  v  I  N  2  :  AMM  <  Y v  1  N  2  *  ?H2  ) 

2020  ”  C  N  T  I  N  L  E 

IF  =  IP  4  1 

IF  (  IF  *AE.  NPRT  )  rC  TC  ?o?D 

TP  r  0 


uRITF  (6,5 

50)  TIYE, 

xc  i , 

x  C  2 « 

XC  3, 

X  C  4  , 

.  XI » 

X  2  , 

X?* 

X  4  , 

x  r  f  i . 

V  C  F  2  , 

.  X  C  F  3  , 

X  P  F  4  , 

7CH 1 , 

2CF2* 

XFl  , 

x  F2 , 

•  X  f  2  , 

XF4, 

7W  1  * 

7F?  . 

F  r  0  * 

■»  ♦ 

.  UC  A* 

Y 

2C20  C  CNTIMF 

3  0  0  0  T  I  fJ  Z  =■ 

TIFF  4  G  • r 

4  CT 

4  0  0  0  CCNTINUr 
6000  CALL  RlAiCK 
2  n  0  0  CONTINUE 

rC  TC  1010 
1  :  00  C  CNTINUE 

' P TS  =  NPT?  4  i 


X  T  <  A  F  T  $  >  = 

T  I  Yp 

YT (kFTS)  : 

Y 

Y  YAX  = 

A  Y  A  X  1 

< 

Y  v  A  X  ,  Y  > 

YY  IN  r 

A  Y  I  M 

( 

Y  y  I  k  ,  Y  ) 

71TC.PT?  )  = 

7F1 

72TC  PT?)  = 

Zk? 

Y  v  A  X  1  : 

A  '>  A  X  1 

( 

Y  y  A  X 1  •  7H1 

) 

>  Y  I  M  ; 

AYIfC 

( 

Y  y  I  A  j  ,  Z  F  1 

) 

Y  Y  A  X  2  = 

A  N  A  X  1 

( 

Y  y  A  x  7  ,  7  F  7 

) 

v  Y  I  \  2  = 

AYIM 

( 

Y  y I  A  ?  ,  7  f2 

) 

*  R I T  r (  6,55  0  ) 

T  I  vr  , 

v  F  1  * 

VC2, 

x  r  2 , 

y  o  4  , 

.  xl  , 

v  2  * 

V’  * 

X  4  , 

>  r  *- 1 , 

V  f'F? 

.  x :  f  ; , 

X  C  F  4  , 

7  r  f  i , 

7  D  F  °  » 

XFl  , 

vp. 

.  X  f  2  , 

X  F  4  , 

7  F  1  , 

7  F  2  , 

pcc. 

V.  « 

UC  A,  Y 

CALL  L I K c  L  T  (  XT,  YT,  CUYY,  Cl'YY,  lf  yYlN,  Y^Ax,  C.,  C., 

o.«  0.  > 
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CPTr? 


FTN  4  •  f  ♦  4  3  9 


2?r 


i 


CALL  LINFLT  (  XT*  Z1T,  Z2T*  CUPP*  NPTS*  2*  Y  P  I N'  1  *  YPAX1* 

.  YFIN2*  YFAX2*  0.*  0.  > 

'  C  TO  210  0 

2  2  C  C  CONTINUE  '  " . 

f'»ITf(6«c100> 

2UC  '  CM  I  MJF 

call  exit 
1C0=CRKAT<8A10> 

15  0  FCRPAT(lt-l,lX,13<2F*  J*?A10«13(2F*  )*////) 

20  0  FCRMAT(/*lXV3F'XM(Il*4F*l)-5  FT2  « f.  VI TT* .  '  ' 

.  3PXP<Il,4P,?):fE12.f«lX*3FXw<Il*4F*3>=*E12.f*]X* 

.  3PXP<Il,4F,4>r,El?.6«lX*3PXK(Il**F«5)5:»E12.6*lX* 

.  3FXF( ri«4F«C l  =  *F12.6  ) 

3  0  C  PCRf'ATJ/,lXt*T(l)r*,2Ctl2.fc*2XJ*lXt*TC2>i*«'2iri‘2;TE«?yr*IXf  ~ 

•  *T(3>=*«2(fl2.6»?X)»/»lXt*T(4)=*»?(E12.t*2X)*lXt 

.  *T<c)r**2(F12.6*?V>,n  .  - 

430  F  C  R  P  A  T  (/»1X**A<1  )=*F12.f*lX««A<2)=**E12.f» 

.  1> ♦*AC3)=*,P12.E,iy.*A(4)=*,^12;efIX* 

.  *A(5J=*»r12.6»lX,*A(P)=*.E12.F*/> 

5  C  0  PCRvAT(/,lX»*R(l)=*E12.f  *lX,iRC2)  =  *.T12.'E» . 

.  ix,*p(,>  =  **ri2.e;»ix*<tR(4)s*fn2.F*3xf 

•  *=  <5>=*«r12.f  ilX,*St£'}tf,F17.f  *73 

550  F  C  R  v  A  T (/»4Xt6FTIFE  = * E 1 4 . 7 »4 X  ,  £5 X C 1  =*F14.7»4X* 

.n-yf'2  =  ♦  r  1 4  •  7  »  4  X 1 6  F  X  T  3  "  -  «  F 1 4V  7  •  4  X  V  f  FX  D 4  =  *F14.7*/*~ 

.4x,P‘-Xl  =«E14.7,4V*fFX?  =«F14.7*4y,6PX3  =*F14.7*4X* 

.ft-V4  :»FH.7|4X,f  bXChl  =«EI4.7*/« 

.***€,FXCF2  =*F14.7,4V «fcFXCH3  =  «  E  1  4 . 7  *  4  >  ,  S-F  X  C  p4  =,E14.7*4Vf 

•  F F Z C H 1  s« E14 •  7«4 X 56 K7CF?  ^ * rr*T57 *7*0*6 FTFT"  sVFTTiT VO*" 

,CFXF2  =  *F14.7,4X  *fct-XF3  =*F14.7,4X*f FXF4  =*E14.7«4>, 

,(b?Hl  =*E14.7*/«4X*6FZH2  =  «  E  1 4 . 7  •  4  X  *  PFP  G  C  =  ♦  E3  4 . 7  »  4  X  " 

,‘FX  =»F14.7,4v,tFUCA  =*E14.7»4X,f FY  •  =*E14.7,//> 

FTC  FCPFAT(/fc<iy»3FAP(»I2t2P)  =  *F12«pc>) 

7  3  0  FCRPAT(/,lX**AP (  2  f>  )  =  *  ♦  r  1  2 . 6  «  /  >  _ 

8CC  FCR  v‘  T  (////*  5X»»rET  =  *»P14.7»3Xt*!JA=**ri4 .7*  3  X  *  *  T=  *  ♦TT«V7T~' 

500  FORMAT  t/*lX**KU>  =  *F32.f*lX**K<2)s**"3?.f* 

.  iy,*K(?)=*tF12.6»lX**K(4)r*,E12.6.JX« 

,  *K(5)=**F12.ftlX,*X(t>=**F12.f»/> 

5100  FCPPATC/////*28X*10C2F**)*4x»34h'VATRIX  IF  SINGULAR*  RUN  IS  A  FORTE 
.  .  4  X  «  1  0  (  2  -  *  *  )  ) 

5200  cCRV8T(lX»£°(2H**)«//*?f V*  * . *  * . 
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LOOPS  LABEL  INDEX  FROM- TO  LENGTH  PROPERTIES 
16  20  I  40  43  14B  OPT 

43  40  I  47  49  I2B  OPT 

60  60  I  31  54  13B  OPT 

76  80  I  36  37  10B  OPT 


SUBROUTINE  LIWPLT(XT«YT1 « Y T? , y T 3 « NX  * " Y T S « Y 1 M 1 M » V 1 K AX  * 
1Y2MIN»Y2MAX«Y3MIN»Y3MAX) 


DESCRIPTION 

THIS  ROUTINE  GENERATES  ON-LINE  PRINTER  °LDTS  FOR 
1»  2»  OR  3  CURVES.  THE  T  A  3  Lf  OF  INDEPENDENT  VARIABLES 
MUST  RE  EVENLY  SPACED. 


INPUT 

1  y  T 

2  YT1 

3  YT2 

4  YT  3 

5  NX 

S  NYTS 

7  Y1MIN 
B  Y1MAX 


9  Y  2  HI N 

10  Y2MAX 


11  Y3MIN 

12  Y3MAX 


TABLE  OF  INDEPENDENT  VALUES.  MUST  BE 
EVENLY  SPACED. 

TABLE  OF  DEPENDENT  VALUES  FOR  FIRST  CURVE. 
TABLE  OF  DEPENDENT  VALUES  FOR  SECONO  CURVE. 
TABLE  OF  DEPENDENT  VALUES  FOR  THIRD  CURVE. 
NUMBER  OF  POINTS  IN  XT. 

NUMBER  OF  CURVES  TO  BE  PLOTTED. 

<NYTS=1»  2  f  OR  3) 

LOWER  LIMIT  OF  yTl  SCALE. 

UPPER  LIMIT  OF  YTl  SCALE. 

IF  Y1MIN  =Y1MAX  t  THIS  ROUTINE  WILL 
CALCULATE  SCALE  VALUES. 

LOWER  LIMIT  Oc  YT2  SCALE. 

UPPER  LIMIT  OF  YT2  SCALE. 

IF  Y2MIN  = Y2M AX  «  THIS  ROUTINE  WILL 
CALCULATE  SCALE  VALUES. 

LOWER  LIMIT  OF  YT3  SCALE. 

UPPER  LIMIT  Oc  YT3  SCALE. 

IF  Y3MIN  = Y3M AX  «  THIS  ROUTINE  WILL 
CALCULATE  SCALE  VALUES. 


OUTPUT 

ON-LINE  PRINTER  PLOTS 


REMARKS 

IF  4  PLOT  OF  1  CURVE  OR  A  PLOT  OF  2  CURVES  IS 
DESIRED.  THE  VARIABLES  NOT  NEEDED  MUST  BE  DUMMY 
VARIABLES  IN  THE  CALL  STATEMENT. 

EXAMPLE. ..TO  PLOT  I  CURVE 

CALL  LINPLTIXVl.YVl.DUMMY, DUMMY. 100 »!♦-!.  0.1.0 10.»0.»0.»0.) 
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SUB 9 OUT  INC  LINPLT(XT« YT1 »YT2, YT3,VX«NYTS,Y1MIN»Y1MAX» 

101 

1 

lY2MIN*Y2MAX«Y3MINtY3MAX) 

101 

2 

DIMENSION  XT(1)«YT1(1).YT2(1),YT3(1).WR><ARR(101> 

101 

3 

DIMENSION  TT(A)»DLM(3)»SCA(5),SCALE(6)»A6C(3> 

101 

A 

DIMENSION  YMIN(3)«Y"AX(3),YLL(3) »YUL(3> 

101 

5 

OATA  BLK»D0T/1H  tlH./ 

101 

6 

DATA  ABC/1HA# 1HB« 1HC/ 

101 

7 

DATA  TT  /1.0«2.0»5.C«10.0  / 

101 

8 

INITI ALI7E 

101 

9 

DO  200  1 1  =1 «  3 

101 

10 

I F'  (  1 1  .GT.  NYTS)  GO  TO  300 

101 

11 

GO  TO  (10»20«33)«  11 

101 

12 

10 

YMN=Y1MIN 

101 

13 

VMX=Y1MAX 

101 

1A 

GO  TO  50 

101 

15 

20 

YMN=Y2MIN 

101 

16 

YMX=Y2MAX 

101 

17 

GO  TO  50 

101 

18 

50 

YMN=Y3MIN 

101 

19 

YMX=Y3MSX 

101 

20 

50 

YMINt II )  =1 •  0E*20 

101 

21 

YMAX ( I I )=-l .0E*20 

101 

22 

DO  60  1=1. NX 

101 

23 

IF1II  .EO.  1)  Y=YT1(I> 

101 

2  A 

IF(II  .EO.  2)  Y=YT2(I) 

101 

25 

IFCII  .EO.  3 )  Y=YT3(I) 

101 

26 

YMIN(II)=AMIN1(YMIN(II),Y) 

101 

27 

50 

YMAX( II)=AMAX1(YMAX(II).Y) 

101 

28 

IF(YMN  .EQ.  Y MX  1  GO  TO  70 

101 

29 

YLL(II)  =  YMN 

101 

30 

YUL  < 1 1 )  =  YMX 

101 

31 

GO  TO  1 A 0 

101 

32 

SET  SCALES 

101 

33 

70 

0=ABS(YMAXlII)-YMlNtII)) 

101 

3A 

I F  t  D  .NE.  0.0)  GO  TO  72 

101 

35 

D  =  0.01*ARS<YMAX(II>> 

101 

36 

I F ( D  .EO.  0.0)  D  =  1.0 

101 

37 

72 

LI  =  ALOG 10(D) 

101 

38 

IF(D  .LT.  1.0)  LI  =  Ll-1 

101 

39 

TEST  =  ,5*10.0**<FLOAT (Ll-8) > 

101 

AO 

DO  75  1=1*4 

101 

A 1 

R  =  T  T (  I  )  *  10.0**FLOAT  <L1) 

101 

A2 

I F ( R  .GE.  D)  GO  TO  80 

101 

A3 

75 

CONTINUE 

101 

AA 

80 

IF(YMIN(II)  .NE.  0.0)  GO  TO  90 

101 

A5 

YLL ( I I ) =0 .0 

101 

A6 

Y  UL ( 1 1 ) =R 

101 

A7 

GO  TO  1 A 0 

101 

A8 

90 

IF (YMAX (II)  .NE.  0.0)  GO  TO  100 

101 

A9 

95 

YUL (II) =0.0 

101 

50 

YLL (II >  =-R 

101 

51 

GO  TO  1  A 0 

101 

52 

100 

P  =  .5*(YMIN( II )*YMAX(II  ) ) 

101 

53 

P  =  3*0.001*R*SIGN(1.0»P> 

101 

5  A 

L2  =  0 

101 

55 
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I F  ( P  .NE.  0.0)  12  =  ALOG10<AP,S(P)  ) 

101 

56 

IF<A8S(P>  .LT.  1.0)  L2=L2-1 

101 

57 

IP=<e*.5*10.0**FLOAT<L2))/10.0**FL3ATtL2) 

101 

58 

IF(IP  .LE.  0)  I«>  =  1P-1 

101 

59 

110 

yLLMI)=FL0AT<IP)*10.0**FL0AT(LP)-.5»:< 

101 

60 

lc  <  VLL  <  1 1  >  .GT.  Y11MC 1 1) )  GO  TO  125 

101 

61 

IF ( YHIN t I I >  .CT.  0.0)  YLLI  II  )  =  A**AX1(0.Q*YLL(  II  >  > 

101 

62 

yul<  in=yt.L<  1 1 > ♦  r 

101 

63 

IF<yumi>  .LT.  YNAXtII))  GO  TO  135 

101 

64 

IF  <  YMAX (II)  .LT.  0.0  .AND.  YUL(II)  .GT.  0.0) 

SO  TO  95 

101 

65 

IF(YUL(II)*YLL<II)  .  G£  .  0.0)  GO  TO  130 

101 

66 

00  120  1=1*10 

101 

67 

TMP1  =  YLL< II)*.l*R*FLOAT<  I) 

101 

68 

IF(ABS<TMP1)  .Lf.  TEST)  GO  TO  130 

101 

69 

120 

CONTINUE 

101 

70 

125 

IP=IP-1 

101 

71 

GO  TO  110 

101 

72 

130 

I F I VUL ( I I )  .GE.  V WAX ( II>)  GO  TO  140 

101 

73 

IFIYMAXUIl-YULCII)  .LE.  .005*R>  GO  TO  1*0 

101 

74 

135 

R  =  2.0  *R 

101 

75 

GO  TO  110 

101 

76 

140 

OLM(II)=CYUL( 1 1 ) - YLL ( 1 1 ) ) /5. 0 

101 

77 

SC A ( 1 1 )  = YLL  < 1 1 ) 

101 

78 

r 

s* 

PRINT  CURVE  WAX  AND  MIN  VALUES 

101 

79 

150 

I F (  1 1  .EQ.l )  WR I TE ( 6  » 160 ) 

101 

80 

160 

FORMAT ( 1  HI ) 

101 

81 

WRITE <6. 170)  II*A3C(II)»YM1N(II)»YMAX(JI) 

101 

82 

170 

FORMAT T1X.7HCURVE  Y « I 1 , 1 X * 1 0 HOENOT ED  BY*1X,A1,4X«4H>*IN  =  1PE10.3* 

101 

83 

12X,4HMAX=1PE10.3) 

101 

84 

200 

CONTINUE 

101 

85 

c 

PRINT  CURVE  SCALES 

101 

86 

300 

WRITE<6,310) 

101 

87 

310 

FORMAT ( 1  HO  > 

101 

88 

DO  350  11=1*3 

101 

89 

IFIII  .GT.  NYTS )  GO  TO  360 

101 

90 

SCALE(1)=SCA(  II) 

101 

91 

00  320  1=2*6 

101 

92 

SCALE (I >=SCALECI-1>*0LMCII> 

101 

93 

IF(ABS(SCAL£<I>)  .LT.  TEST)  SCALE(I)  =  0.0 

JO. 

94 

320 

CONTINUE 

101 

95 

330 

WRITE<6*340)  ABC(II>*  (  SC ALE U ) . I =1 • 6  ) 

101 

96 

340 

FORMAT  (  IX  *6HSCALC  *A1*10X*1‘>E10.3*10X*19E10. 

3*10X*1PE10.3*10X, 

101 

97 

HPE10.3tl0X*lPE10.3»10X»lPE10,3) 

101 

98 

350 

CONTINUE 

101 

99 

360 

NXP  =NX* 10 

101 

100 

WR 1 TE ( 6 • 365 ) 

101 

101 

365 

FORMAT ( 1 HT ) 

101 

102 

0X=XT<2)-XTC1 ) 

101 

103 

DO  800  I=1*NXP 

101 

104 

URK ARR ( 1 ) =DOT 

101 

105 

DO  375  UJ=2 *101 

101 

106 

J  =  JJ 

101 

107 

WRKARRl J)=BLK 

101 

108 

IF(MOO<  < J-1)*10).EQ.0)  WRKARR  <  J) =OOT 

101 

109 

Ir  < I .EO.l )  WRKARR ( U) =OOT 

101 

110 

IF (MOO  C (1-1)*5).EQ.0>  WRKARR ( J)  =  OOT 
375  continue 

IF(I.ST.NX)  GO  TO  750 
400  00  420  11=1*3 

I F  <  1 1  .GT.  NYTS)  GO  TO  720 
IFUI.EG.l)  Y=rTl(ll 
1MII.E0.2)  Y  =  YT2<  1) 

1C(11.E0.3)  V=YT  3  < I ) 

NP=100t (Y-YLL(II) )/<YUL<II)-YLL< II ) 1*1.5 
IFCNP  .GT.  101)  NP=101 
IF<NP  .LT.  1)  NP=1 
URKARRCNP)=ABC<  II) 

420  CONTINUE 

PRINT  LINE  OF  DESIRED  PLOTS 
720  X  =  X T (  I  ) 

Ic  C I.EO. 1 )  GO  TO  740 
IF<NOO<(I-l)*10).Efl.O)  GO  TO  740 
WRITE(6»730>  URKARR 
730  FORMAT(20X*101 A1 ) 

GO  TO  BOO 

740  WRITE(S«750)  X*WRKARR 
750  FORMAT(10X»1PE10.3*101A1 ) 

GO  TO  BOO 

760  X=XTtNX)*FLOAT(I-NX)*DX 

IF(MOO< <1-1 ) *10) .EO.O)  GO  TO  820 
WRITE<6»730)  JRKARR 
900  CONTINUE 
GO  TO  830 

820  WR I TE ( 6  »  750 )  X  «  WRKARR 
330  WRITE<6»835) 

835  FORMATtlHS) 

RETURN 

END 


101  111 
101  112 
101  113 
101  114 
101  115 
101  1 IS 
101  117 
101  118 
101  119 
101  120 
101  121 
101  122 
101  123 
101  124 
101  125 
101  126 
101  127 
101  128 
101  129 
101  130 
101  131 
101  132 
101  133 
101  134 
101  135 
101  136 
101  137 
101  138 
101  139 
101  140 
101  141 
101  142 
101  143 


SU3R0JT  INC  SESOMI <X,N,N9»MS,MN1,D,R,E.W0RK,1HL0, IC. ID* IS) 
OESCRI°TION 

THIS  SUBROUTINE  WILL  SOLVE  AN  N  3y  V  SYSTEM  OF  SIMULTANEOUS 
EQUATIONS  wITH  AN  ARBITRARY  NUMBER  OF  RIGHT  HAND  SIDES  OR 
INVERT  A  “ATRIX  OF  ORDER  N.  IN  THE  PROCESS*  THE  RANK  OF 
THE  MATRIX  ANO  ITS  DETERMINANT  ARE  EVALUATED.  THE  METHOD 
USE  1  IS  THAT  OF  GAUSS-JORDAN  WITH  TOTAL  PIVOTING  IF  DESIRED. 


INPUT 

1  X 

2  N 

3  NB 
A  MS 

5  MN1 

6  WORK 

7  IHLD 
9  IC 

9  ID 
10  IS 


FIRST  LOCATION  OF  INPUT  COEFFICIENT  M A TR  I  X  *  X ( 1 1 1 ) 
AUGMENTED  BY  N9  RIGHT  HAND  SIDES.  FOR  MATRIX 
INVERSE*  X  IS  FIRST  LOCATION  OF  THE  MATRIX  TO  BE 
INVERTED.  I.E.  X(l,l).  X  *JST  BE  DIMENSIONED 
TC  <  MN1 . MN 1 ♦ NR  >  IN  THE  CALLING  PROGRAM  IN  EITHER 
CASE. 

NUMBER  OF  SIMULTANEOUS  EQUATIONS  TO  3E  SOLVED* 

OR  ORDER  OF  MATRIX  TO  3E  INVERTED. 

NB  =  NUMBER  Oc  RIGHT  HAND  SIDES  FOR  SIMULTANEOUS 
EQUATION  SOLUTION.  NB  =  N  FOR  MATRIX  INVERSE. 

MS  =  0  FOR  SIMULTANEOUS  EQUATION  SOLUTION. 

MS  =  1  FOR  MATRIX  INVERSE. 

ROW  DIMENSION  OF  X  AS  DEFINED  IN  CALLING  PROGRAM. 
WORKING  ARRAY  DIMENSIONED  AS  FOLLOWS  IN  CALLING 
PROGRAM...  W0RK<MN1*N3)  . 

WORKING  ARRAY  DIMENSIONED  AS  FOLLOUS  IN  CALLING 
PROGRAM...  IHLO(MNl). 

IC=1«  PIVOTING  BY  ROW  ONLY.  NORMALLY  SUFFICIENT. 
1C=0,  PIVOTING  BY  ROW  AND  COLUMN,  RUNS  LONGER. 

ID=1»  DETERMINANT  CALCUALTED. 

ID=0,  DETERMINANT  NOT  DESIRED. 

IS=1*  MATRIX  IS  NOT  SCALED  PRIOR  TO  MANIPULATION. 
IS=0«  EACH  MATRIX  ELEMENT  IS  SCALED  PRIOR  TO  MANIP. 


OUTPUT 

1  X  X(l»l)  THROUGH  X<N,1>  CONTAIN  FIRST  SOLUTION 

VECTOR.  X ( 1  *  2 )  THROUGH  X(N»2)  CONTAIN  SECOND 
SOLUTION  VECTOR*  ETC.  FOR  MATRIX  INVERSE.  THE 
ARRAY  X  CONTAINS  THE  INVERSE  MATRIX. 

2  0  DETERMINANT  OF  INPUT  X. 

3  R  RANK  OF  INPUT  X. 

A  E  ERROR  CHECK 

E=0  O.K. 

E  =  1  MATRIX  OF  COEFFICIENTS  IS  SINGULAR. 

E=2  SOLUTION  IS  ATTEMPTED  BUT  EQUATIONS  MAY  BE 
SINGULAR  OR  ILL  CONDITIONED. 


REMARKS 

THIS  SUBROUTINE  WILL  RUN  FASTER  WITH  I C  =  1  AND  IS  =  1.  THE  VALUE 
IC  SHOULD  BE  SET  TO  0  ONLY  IN  RARE  CASES  WHERE  EXTREME  ILL- 
CONDITIONING  IS  EVIOENT  ANO  IS  SHOULD  BE  SET  TO  0  ONLY  WHEN 
ELEMENTS  OF  ONE  ROW  OF  THE  MATRIX  IS  MUCH  GREATER  THAN  THE 
ELEMENTS  OF  OTHER  ROUS.  CAUSING  A  FALSE  E=2.»  INDICATOR. 
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SUBROUTINE  SESOMI (X .N.NB.MS »MN1 .D.R.E « WORK, I HLO« IC. IO« I S ) 
DIMENSION  X(MN1.1).W0RK< 1)«1HL'J<1 ) 

DOUBLE  PRECISION  X.wORK.Y.D.SUM.Xl 

THE  FOLLOWING  9  CARDS  ARE  TEMPORARY  MODIFICATIONS  TO  ALLOW 
EXISTING  CALLS  TO  SCSOMI  (USING  10  ARGUMENTS)  TO  WORK  PROPERLY. 
ANY  CALLS  NOW  MADE  SHOULD  INCLUDE  ALL  13  ARGUMENTS. 

J  =  LOCF(IC) 

I F ( J  .GT.  64  >G0  TO  50 
IIC  =  C 

no  =  l 

IIS  =  o 
GO  TO  51 

50  IIC  =  IC 

iio  =  id 

IIS  =  IS 

51  XI  =  1. 

E  =  0. 

R  =  0. 

I F  <  II  C  .NE.  0 ) GO  TO  211 
DO  21  1  =  1  .  N 
21  1 HLD ( I  )  =  I 
211  CONTINUE 

IF(MS>6.4»6 
6  NN=N*N 
N8  =  N 
MN=N*1 
DO  14  1=1. N 
DO  14  J=MN»NN 

14  X<I,J)=0. 

DO  15  1=1. N 
J  =  I  ♦  N 

15  X(  I,J)  =  1. 

GO  TO  16 

4  NN=N»N6 

16  J J  =  NN 
NNN=N~1 
0  =  0  . 

IFtHD  .NE.  0)0=1. 

I F ( 1 1 S  .NE.  0 ) GO  TO  361 
00  36  1=1. N 
Y  =  X(  I  . 1  ) 

DO  35  J=2.N 

IF(ABS(Y).LT.ABS(X(T«J)))Y=X(I*J) 

35  CONTINUE 
D  =  D*  Y 

DO  36  J=1,NN 

36  X(1.J)=X(I»J)/Y 
351  CONTINUE 

DO  5  1=1. N 
KK=N- I 

I F  <  K K ) 1 0 , 1 0 , 26 
26  IFUIC  .NE.  0 )  GO  TO  261 
LL=KK»1 
I  JU  =  1 
L=T 


F  01  9 

F01  10 

F01  11 

F01  12 

F01  13 

F  01  14 

F01  15 

F  01  16 

F01  17 

F01  18 

F01  19 

F01  20 

F01  21 

F01  22 

F01  23 

F01  24 

F01  25 

F01  26 

F01  27 

F01  28 

F01  29 

F  01  30 

F01  31 

F  01  32 

F01  33 

F01  34 

F01  35 

F01  36 

F01  37 

F01  38 

F01  39 

F  0 1  40 

F  0 1  41 

F01  42 

F01  43 

F01  44 

F01  45 

F01  46 

F  01  47 

F  0  1  48 

F01  4Q 
-  ::  5o 
F  0 1  51 

F  0 1  52 

F  0 1  53 

FP1  54 
F  01  55 


WOR<(l)=X(l»l) 

F  0 1 

56 

DO  17  11=1, LL 

F  0 1 

57 

DO  17  J= 1 « LL 

F  0 1 

58 

IF< A3S<  WORM  1 >>-ABS(X(II,J>>>18,17,17 

F  01 

59 

ie 

WORK ( 1 >  =  X  I  1 1 »  J ) 

F  0 1 

60 

L=J*I-1 

F  0 1 

61 

I  J  J  ”  J 

F  0 1 

62 

1  7 

CONTINJE 

F  0 1 

63 

I F  t  IJJ-ir 2,2,19 

F01 

64 

19 

DO  20  11  =  1, \ 

F  0  1 

65 

y=x<ii»i> 

F  0 1 

66 

X(II,1)=X(II,IJJ) 

F  0 1 

67 

20 

X  (  1 1 , T  J J)  =  Y 

F01 

68 

IY  =  IHLO(  I  1 

F  0 1 

69 

I HLD  < I )  =  I  HID ( L ) 

F01 

70 

IHLD(L)=IY 

F  0 1 

71 

D  =  -D 

F  0 1 

72 

261 

I  JJ  =  1 

F  0 1 

73 

Y=X(l,l) 

F  0 1 

74 

2 

DO  1  L= 1 , KK 

F  0 1 

75 

IF(ABSCY)-ABS(X(L*1,1)))7,1,1 

F  0 1 

76 

7 

I J J=L ♦ 1 

F01 

77 

Y=X (L*l , 1 ) 

F  0  1 

78 

1 

CONTINUE 

F01 

79 

IFCIJJ.EQ.l)  GO  TO  10 

F  0  1 

80 

D  =  -0 

F  0  1 

81 

DO  9  J=1,JJ 

F  0  1 

82 

Y=X(1,U) 

F  0  1 

83 

X(1,J)=X(IJJ,J> 

F  0  1 

84 

9 

X< I JJ, J)=Y 

F  0 1 

85 

10 

JJzJJ-1 

F01 

86 

0=0*X(1,1) 

F01 

87 

IF(X(1,1).EO.O.)GO  TO  8 

F  0 1 

88 

31 

I  F  < ABS< ABS<  <X1-X< 1,1 ))/Xl >-l . ) .LT.l ,E-7)E=2. 

F  0 1 

89 

X1=X<1,1> 

F  0 1 

90 

11 

R  =  R  ♦  1 • 

F01 

91 

DO  12  J=1,JJ 

F01 

92 

12 

JORK(J)=X(l,J*l)/X(l,l) 

F  0 1 

93 

KK= JJ*1 

FO  a 

94 

IF(NNN.EQ.O)GO  TO  33 

F  0 1 

95 

DO  3  K= 1 , NNN 

F  0 1 

96 

DO  3  J=2»KK 

F  0  1 

97 

3 

X(K, J-1)=XCK*1, J)-X(K*l,l)*WORK(  J-l) 

F  0 1 

98 

33 

DO  5  J=1,JJ 

F  0 1 

99 

5 

X(N,J)=WORK( J) 

F01 

100 

I  F  (  1 1 C  .NE.  0 ) GO  TO  13 

F  0  1 

101 

NNrN-1 

F  0  1 

102 

IFCNN.EO.OIGO  TO  13 

F01 

103 

DO  22  1  =  1, NN 

F  0  1 

104 

L  =  I  ♦  1 

F01 

105 

DO  22  J=L»N 

F  0 1 

106 

IF (1HLD(I )“IHLD(J))22,22,23 

F  0  1 

107 

23 

I V= I HLD  C I » 

F  0 1 

108 

I  HLD ( I )  =  I HLD  <  J) 

F  0  1 

109 

IHLD( J)=IY 

F01 

110 

47 


00  25  K=1.NB 
Y  =  X<  I«K) 
X(I.K)=X(J,K) 
25  X  ( <i«  K  )  =  Y 
22  CONTINUE 
13  RETURN 
8  E  =  l. 

RETURN 

END 


F01  111 
F01  112 
F01  113 
F01  UR 
F01  115 
F01  116 
F  0 1  117 
F01  118 
F01  119 
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APPENDIX  B 


SAMPLE  RUNS 


Several  complete  sample  runs  are  presented  in  this  Appendix  in  order 
to  furnish  examples  of  the  output  which  results  when  this  program  is  run 
on  a  stand-alone  basis.  The  plant  used  for  the  examples  is  a  simplified 
autopilot  loop  described  by  aerodynamic  transfer  function  and  compensator 
data  taken  at  various  times  along  a  nominal  trajectory  (see  Reference  7). 
For  each  case,  the  NAMELIST  input  section,  the  X  matrix  (before  and  after 
inversion),  output  data  as  listed  in  Table  3,  anc?  line  printer  plots 
showing  output  Y  and  disturbance  state  estimates  z^,  z^  are  given. 

The  disturbances  used  in  each  run  are  as  follows: 


(a) 

Run 

1: 

w(t) 

=  1. 

(b) 

Run 

2: 

w(t) 

=  1.  +  0. 5t 

(c) 

Run 

3: 

w(t) 

-  1.5  +  0. 5e" 25t 

runs 

(a) 

and 

(b). 

where  the  disturbance  is  of  the  form  w(t)  = 

the  disturbance  is  modeled  as 


For  run  (c) ,  the  disturbance  is  of  the  form  w(t)  ■ 
modeled  as 


+  o. 


Co  +  c^eat  and  is 


!::](:;)  ** 
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IriECSDlNO  ftua  aUMt-NOT  Fix*® 


L 
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